#include <wiringPi.h>
#include <softPwm.h>
#include <stdio.h>

int main()
{
	const int motor_a=26;
	const int motor_b=23;
	const int button=21;
	int duty=0;

	wiringPiSetup();
	pinMode(button, INPUT);
	softPwmCreate(motor_a, duty, 100);
	pinMode(motor_b, OUTPUT);
	digitalWrite(motor_b, LOW);

	int input_prev=HIGH;

	while(1){
		int input_cur=digitalRead(button);

		if(input_prev==HIGH && input_cur==LOW){
			++duty;

			if(duty>100)
				duty=0;

			softPwmWrite(motor_a, duty);
			printf("duty: %d\n", duty);
		}

		if(input_prev!=input_cur)
			input_prev=input_cur;

		delay(20);
	}

	return 0;
}